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At the measurement timei the state estimate and covariance are updated 


by 


^( + ) - ^(-) + - h^(4<-))) (7) 

and 

P^(+) - (I - 

idiere the ( •) and ( + ) represent the appropriate values just before 
and just after the update. Ihe updated values are ut:ed to reinitialize 
the time propagation equations (3) and (4) for integrating up to the next 
measurement time. Hie Kalman gain matrix is computed as 

This algorithm is repeated until the last time point, t^, is processed. 

For later use in the smoother ad.gorithm, various combinations of the state 
estimates (x), measurements (z), linearized dynamics matrix (P) and 
measurement matrix (H), measurement noise covariance (R) and estimation 
error covariance matrix (P) must be stored for each time instant to be 
processed by the smoother algorithm . 

2 .2 Modified Bryson ~Frazier Smoother Algorithm 

The operation of the smoother algorithm is similar to the filter 
algorithm except in reverse time. The derivation of this smoother algoritlsn 
is found in reference [2]. This fixed interval smoothing algorithm pro- 
vides optimal estimates given all the measurements in comparison to the 
filtering algorithm providing optimal estimates given the previous 


1 .0 INTRODUCTION 


This fourth monthly progress report again contains corrections and 
additions to the previously submitted reports. Ihs additions include a 
simplified SRB model that is directly incozrporated into the estimation 
algorithm and provides the required partial derivatives. Ihe resulting 
partial derivatives are analytical rather than numerical as would be the 
case using the SOBER routines. 

Ihe filter and smoother routine developments have continued. Ihese 
routines are being checked out. 


2.0 FILTERING AND SMOOTHING ALGORITHM 


The Space Shuttle Parameter Estimation I^ogram utilizes optimal 
estimation techniques to provide estimates of the propulsion system 
parameters. The technique selected is the extended Kalman filter and 
the modified Bryson -Frazier smoother. By modeling the propulsion system 
parameters as time correlated random variables > improved estimates of 
these parameters are obtained and are properly time leased by removing 
the filter induced lag by using the combined f il ter /smoother . The 
smoother also provides improved estimates of the initial state estimates. 

The system, in state-space notation, is modeled eis the continuous 
dynamical system disturbed by additive Gaussian white noise 

X » ^(x(t), t) + G(t) w(t) + u(t), x(o) - ^ (1 ) 

Uhere 

X s n -dimensional state vector 

X » Gaussian initial condition vector with covariance P 

-o o 

w(t) = p-dimensional 'iAiite, zeronnean vdiite Gaussian noise with 
covariance 

E[w(t) w^(t)] = Q(t) 6(t - t) 

u(t) * n-dimensional control vector. 

Tt.a elements of the vector jc(t) represent vehicle position, velocities, 
attitudes, angular rates, aerodynamic and propulsion parameters, measure- 
ment biases, etc. Elements of vi(t) include knoim control inputs such 
as SSME power level command j . 


The system described by equation (1) is observed at discrete times, t^^, 
with not all states being directly measured. Some measurements are non- 
linear functions of the elements of the state vector x(t). In general 
the measurement process is described as 

( 2 ) 

where 


» m-dimensional observation vector 
^ a functional representation of the measurements in terms of 
the states 

Vj^ * m-dimensional, zero-mean, vhile Gaussian noise sequence with 
covariance 


E[v. v*!*] = R. 6. . 

Ebcamples of the elements of the observation vector ^ include radar 
measurements of ramge, azimuth, and elevation from the radar site to the 
vehicle . 

It is assumed that the system process noise vector w(t) and the 

measurement noise vector ^ are uncorrelated. Also, the system state 

initial condition vector x is not correlated with either of these two 

~o 

noise vectors. Therefore 


E[w(t) 2 ^] = 0, E[w{t) x"^] 


0, E[x vj] - 0 
— o -k 


where the superscript T denotes transpose. For later reference, the 


following matricies are defined 


F(x(t), t) 


(3) 


3f(x(t), t) 

3x(t) 

and 

ah(x(t ) ) 

These matricies are linearizations of the dynamics sad m lasurement models 
respectively, evaluated about either a nominal or reference value of the 
state, or about the state estimate. 

2.1 Extended Kalman Filter Algorithm 

The extended Kalman filter algorithm is in essence a conventional 
linear Kalman filter algorithm ^plied to a mathematical model resulting 
from the linearization of the system model equation (1), cuid measurement 
process, equation (2), about a current state estimate. The filter yields 
optimal estimates if the linearization is accurate, i.e., the state esti- 
mate closely approximates the true state. The derivation of the algorithm 
can be found in reference [1]. 

The algorithm proceeds as follows. After initialization of the state 
estimate and covariance, the state estimate and covariance are propagated 
forward in time until a measurement update is available, by 

X = ^(x(t), t) , tj^ ^ < t < t|^ (5) 

and 

P(t) « F(x(t), t) P(t) + P(t) F(x(t), t)"^ + G(t) Q(t) GCt)"^ 


( 6 ) 



At the measurement timet the state estimate and covariance 2 ure updated 


by 


4 '*' - 4 '-' "> 

and 

Pj^(+) - (I - 

where the ( -) and (+) represent the appropriate values just before 
and just after the update. The updated values are u&;ed to reinitialize 
the time propagation equations (3) and (4) for integrating up to the next 
measurement time. The Kalman gain matrix is computed as 

This algorithm is repeated until the last time point, t„, is processed. 

For later use in the smoother algorithm, various combinations of the state 
estimates (x), measurements (z), linearized dynamics matrix (P) and 
measurement matrix (H), measurement noise covariance (R) amd estimation 
error covariance matrix (P) must be stored for each time instant to be 
processed by the smoother algorithm. 

2 .2 Modified Bryson -Frazier Smoother Algorithm 

The operation of the smoother algorithm is similar to the filter 
algorithm except in reverse time. The derivation of this smoother algorithm 
is found in reference [2]. This fixed interval anoothing algorithm pro- 
vides optimal estimates given all the measurements in comparison to the 
filtering algorithm providing optimal estimates given the previous 


measurements processed, 'nterefore the smoother provides Improved estimates 
in addition to removing the time lag induced by the filter algorithm. 

The smoothing algorithm adjoint variables « ^ and A are "initialized" 
at the final time processed by the filter, T, 


X(T-) . 




N,T 


and 


( 10 ) 


A(T-) . H^(H^ P^ hI . 


N,T 


(11 ) 


If T is not an observation time, ^ and A are zero. The adjoint 
variables are propagated in reverse time to the next previous measurement 
time by 


X » - P(x(t ) , t ) X 


t. < t < t 
k — 


k+1 


( 12 ) 


A * - F(x(t), t)'^ A - A F(x(t), t) 


(13) 


At the time of an available measurement, tj^, the adjoint variables 
are updated by 


X(-) . XU) - p^ . p^,-' . h^(3^(-))) 

* '’x <i<*» 


(14) 


A(-) - (I - 1^)’' A(.) (I - K, H^) 4 hJ(H^ P,^ hI . P,^)’’ (15) 


and 


The smoother state estimate and error covariance eire obtained using the 




filter estimate and covariance and the adjoint variables by 
x*(t) - x(t) - P(t) l(t) 

and 


P*(t) - P(t) - P(t) A(t) P(t). 


(16) 


(17) 


Due to the potential number of time points to be processed ^ smoother 
estimates may only be computed at the discrete measurement times. For 
this approach the propagation equations (1C) and (11) ara replaced by 

(18) 

and 




(19) 


where is the state transition matrix formed with the linearized 

k 

dynamics matrix F to propagate the adjoint variable from time 
to time t|^. "he algorithm continues in reverse time until the initial 
time is reached. 


2 .3 Iterations with the Filter/9noother Algorithm 

The performance of the filter /smoother algorithm is a direct result 
of the accuracy of the linearization. Repeated operations of the algorithms 
with adjustments in initial state estimates and covariance in each cycle 
can yield improved estimates . This technique is known as global iterated 




tiltering as defined in reference [31. Each cycle of operating the 
algorithms would yield increasing improvements in the state estimates. 

Ihis feature of the algorithm operation is of special interest to 
the propulsion parameter estimation problem using the NASA predictive 
models. Initial, or nominal, values of the parameters of interest can 
be used to obtain the necessary partial derivatives indicated earlier. 
Prom operating the algorithm improved estimates of those parameters are 
obtained. Using these improved estimates, more accurate partial deriva- 
tives are obtained for use in the algorithms. Ihis process is continued 
until there is in essence no change in the partial derivatives or quality 
of the state estimates. If the linearization is accurate, the measure- 
ment residual should be a vrttite noise process with known covariance. 


3.0 FILTER/SMOOTHER ALGORITHM SYSTEM AND MEASUREMEa<T MODEL 


lha utafulness of th« filter /smoother algorithm is to provide esti- 
mates of the system states from the observed motion and dynamics vrhile 
the system is driven by known and unknown elements . Ihese unknown el«nents 
are elements of the systwn state vector to be estimated. The evolution of 
motion resulting fr^ these known and unknown elements is assumed to be 
suitably represented for this study by a six degree -of -freedom (6 DOF) rigid 
body equations of motion. These equa''ions are presented and discussed in 
section 3.1 . 

Tb implement these equations into the filter /smoother algorithm 
presented in section 2.0, a linearization of the system state and measure- 
ment models is required. These linearized equations are presented in 
section 3.2. 


3.1 Equation.'; of ^fc?tion and Measurement Equations 


3.1.1 Rigid Body Equations of Motion 

The rate of change of vehicle velocity in body coordinates , 


as a result of external forces acting on the vehicle is described 
2 

n A\/ 

•(B) 

- “2m 


(B) ^B) 

m B^I (I) , (I), (B) ^ ^ 

C-+C2^ (r )-uxv + — — + 


m 


m 


(B) 

V 

by 


( 20 ) 


where 

p s atmospheric density 

A « aerodynmnic coeificient referenced area 

V « magnitude of vehicle velocity relative to the surrounding air 


mass 



ra > vthicl* mat* 


■ aarodynmic fore* coafficlant vactor 

• gravity vactor in inartial coordinatas 
til ■ angular rotation of tha body ralative to tha inartial frama 
(B } 

• rasultant thrust force vactor in body coordinatas 
(B ) 

f p - resultant plume force vector in body coordinates 

Ihe rate of change of vehicle position ir. inertial coordinates, 
is then obtained by 


•(I) I^B (B) 
r • c v 


(21 ) 


I B 

vdiere C is tha transformation matrix from body coordinatas to 

I B 

inertial coordinates . Thm elements of the C transformation matrix 
are obtained frtxn the re^ultinq Euler angles defined by 


a 

f 


1 sinftanS 'osytanB 


P 

a 

0 

m 

0 cosy -sing 


q 

L j 


0 singsec6 cosfsecB 

. 


r 

m m 


tdiere B, and 4* are roll, pitch and yaw attitudes respectively. 

The roll, pitch and yaw rates of the body relative to inertial coordinatta 
are p, q, and r respectively. Finally, the rate of change of the body 
rates relative to inerwial is given by 
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ID 


P 

q 

f 


[i]"^ t 


PAv 


m 


PAv 


Ic + -• 


m 


(r 


(B) 


(B), 
- r ) 
-eg 


xc^ 


- Ul X (Tu) ) 


-T 


+ Tp ] 


(23) 


where 


I = vehicle moments of inertia matrix 

£c = aerodynamic coefficient referenced length and moment 
fn 

coefficient vector 
(B) 

r = vehicle center-of -gravity vector in body coordinates 
-eg 

( B ) 

r^ = aerodynamic coefficient reference position in body coordinates 
(B ) 

^ = resultant thrust torque vector in body coordinates 

( B ) 

Tp = resultant plane torque vector in body coordinates 


The equations of motion represent the first twelve eluents of the system 
state vector. Ihese equations are suimnarized in Table 3.1 .1-1 . 

Hie moment of inertia matrix I in general is given by 



I 

-I 

-I 


x 

xy 

zx 

I 

-I 

I 

-I 


xy 

y 

yz 


-I 

-I 

I 


zx 

yz 

z 

the moment 

axis terms , 

i.e. 


( 24 ) 


I . 
zx 


i.e. , 


Equations of Motion 


original i ;v 
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Ihe aerodynamic force and moment coefficients and plume forces are 
defined as functions of angle -of -attack , a, and angle-of -sideslip, 6, as 
shown in Figure 3.1 .1-1 . Ihe body referenced relative velocity vector, 
removing the wind velocity, v , fr(^ the vehicle velocity, is given by 


(B) 


- 


V = V 


(B) 


B LL (LL) 
- C V 


(25) 


where v^'^^ ^ is the local -level referenced wind velocity vector. Ihe 
following equations define a and B in terms of the components of v 


V 

. -1 f ^3 

a. = tan ( ) 

V 
^1 


(26) 


B = sin ( ) 

V 

m 


(27) 


vrtiere 


V -(v^+v^+v^) 
™ ^1 ^2 ^3 


(28) 


(B ) 

Bie resultant thrust force f^ is e:q>anded as 


fl®^ = .Z 

1=1 1 


T. 

1 

0 

0 


A ” B„^ 


(29) 


B 

Where the transformation matrix C transforms the magnitude of thrust 


for each thrusting device, f^, from its center-line to the body 

i 


coordinates . The general eqaution for f 


T. 

1 


is 



RELATIVE 

VELOCITY 

VECTOR 
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T. 

ivac 


P 


s. 

1 


A 

e 


where 


= vacuum thrust 


ivac 


P ■ atmospheric pressure at motor exit 
“i 


A = motor exit cone area 
e 


B *L 

Ihe matrix C is different for the SSMB's and SRB' s and is given by 




B^MP MP^G- G^<L SSME 

C C C 


(30) 




SRB 


where 

8 MP 

C = transformation from the engine mount plane to the body 
coordinates 

MP G 

C s transformation from the gimbal reference plane to mount plane 
(structural deformation) 

G ^ 

C = transformation from enterline to the gimbal reference plane 
B ^ 

C = transformation from SRB nozzle centerline to the body 


coordinates (gimbal angles ) . 


The resultant thrust torque is the sununation of the torque contribution 
from each thrusting device and is given by 


-T 


n 

iii 


, (B) 
1 


BK 

r ) X C, 

-eg 1 


T. 

1 

0 

0 


(31 ) 


vdiere 



body coordinates of the thrust reference point for the 
i^^ thrusting device. 


3.1 .2 Measurement Equations 

Ibe measurements assumed available for the filter 'smoother cULgorithm 
include inertial platform acceleration and attitudes, ground based radar 
tracking, SRB's head pressure, SSME' s chamber pressures, liquid flow 
rates, pressurant flow rates, llie ET volumetric levels are available; 
however, due to their limited number (4), they may only be used for 
alternate checks of the filter/smoother algorithm performance. 

Tbe propulsion related measurements will be treated in a separate 
section. In the following, the inertial platform acceleration measurements, 
attitude measurements and ground based tracking measurements models will 


be described for later linearization. 



3.1 .2.1 Platform Acceleration Measurements 


Accelerometers mounted orthogonally on an inertially stabilized 
platform, not located at the vehicle center of gravity, sense externally 
applied special forces and accelerations due to body rotation, ihe 
accelerometer measurement is modeled by 


(S) _ s P P P. ^ 

-m ^ ^ m m 


, (B) (B), • , (B) (B),, . (S) (S) 

+ u) X ( 1 ) X (r„ - r ) + ta) X (r„ - r ) J + b + v 

— — -6 -eg — -S -eg -e -e 


(32) 


where 


SeP 


p P' 

c 


P-CB 



= transformation from platform coordinates to sensing coordinates 

= transformation from misaligned platform coordinates to 
platform coordinates 

= transformation from body to misaligned platform coordinates 
= body coordinates of the platform center 
= accelerometer bias vector 
= accelerometer measurement noise vector 


3. 1.2. 2 Platform Attitude Measurements 

The inertially stabilized platform for the STS is a four axis IMU 
with a redundant roll axis [4]. Vehicle body attitudes are generated 
via quaternions [5]. It is assumed that an equivalent representation 



can be made to obtain vehicle attitude by a three rotation sequence of 
roll, pitch, yaw to transform from inertial to body coozdiantes. Ihis 
approach has been used in reference [6]. 

The attitude angle measurement model is given by 







(S) 


(33) 


tdiere 




P P' 

platform misalignment bias vector (used to formulate C ) 



attitude measurement noise vector. 


The transformation matrix used to transform from body to inertial 
coordinates in terms of the elements of the 6 vector is given by 


cos6cos<|» 

sin9sin6cos4> 

cos(psin9cos4* 


-cos9sin4> 

■fsin9sin4< 

cos6sin<|» 

sin9sin6sin4> 

cosipsinSsin^' 


•fCOS^COS^ 

-sin9cos4< 

-sin0 

sinfcosS 

cosfcosG 


(34) 


3. 1.2. 3 Ground Based Tracking Measurements 

Grounc. based radar tracking devices cem provide measurements of 
range, azimuth and elevation from the radar sight to the vehicle. Azimuth 
and elevation are established relative to the sight's local level. If 
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the tracking device is a passive optical tracker (not laser) then only 
azimuth and elevation measuremonts are available requiring more than one 
to establish position information. 

Defining x, y* and z as the local easti north and up position of the 
vehicle relative to the ground based tracking device > the radar measurement 
equations are given by 

p = (x^ + + z^) + b + v (35) 

P P 

A » tan‘^ (~) + b, + V, (36) 

y A A 

E a tan ^ ^ " ) ■*. b_ + AE + v_ (37 ) 

ri — r ^ ^ 

y X + y 

where 


b 

P 


i 



range, azimuth, elevation biases 


AE = atmospheric refraction correction 

^ = range, azimuth, elevation measurement noise. 

p A C# 


The position vector of the vehicle relative to the tracking device is 
given by 


to"-'-’ 

“i-v 


LL ECP 
C 


.ECF ECI (I) 
[ C r 


(ECP), 
- ::«DR ' 


( 38 ) 


z 


t^ore 
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LL^ECF 

ECF^ECI 

(ECF) 


- transformation from earth center fixed to local level 
^ eairth centered inertial to earth centered fixed 
> position vector of tracking device in ECF coordinates. 


The transformation matrix 


LL^ECF 


is given by 


-sinX 

->sinLcosX 

cosLcosX 

cosX 

-sinLsinX 

cosLsinX 

0 

cosL 

sinL 


(39) 


where L and X eire the geodetic latitude and east longitude of the 

ECF EC I 

device. The transformation matrix. C is given by 


ECF^ECI 


- W’ 

sin[o) (t 

E 

- ‘rnp” 

0 



cos (u) (t 
E 

- ‘rnp” 

0 

[RNP] (40) 

0 

0 


1 



where 


«•> =• earth rotation rate 

C« 

t » time tag for RNP matrix 

RNP 

(ECF ) 

The position vector, rl , of the tracking device is given by 






(ECF) 


( — 

V COS^L -f (1 

( 


h 

- e)^ ain^L 


V cos^L + (1 - e)^ *in^L 


V cos^L + (1 - e)^ sin^L 


■f h) cosLcosX 


<f h) cosLsinX 


•f h) sinL 


(41 ) 


^er« 


Rj. ■ equatorial radius of Ficjher ellipsoid 
e * flattening of Fisher ellipsoid 
h ■ altitude of the device above Fisher ellipsoid 


3.2 Linearized System State and Measurement Equations 


The vehicle equations of motion are nonlinear functions of their 
motion variables and are implicit functions of other elements of the 
system states. The measurement equations involve similar function rela- 
tionships. The linearizations for the filter /smoother algorithm require 

( B ) 

peurtial derivatives with respect to the motion variables, i.e., v and 
8, ^md with resp>ect to other elements of the state vector, yielding 
explicit functional relationships for the elements of interest. 

For system state equations the partial derivatives will be presented 
in section 3.2.1 for tho state elements in order of occurrence for the 
first twelve states. Other partial derivatives for candidate state ele- 
ments will follow in section 3.3.1. The measurement equation partial 
derivatives for the first twelve states will be presented in section 3.2.2. 
Partial derivatives of the measurement equations for other candidate states 
will be presented in section 3.3.2. 

The resulting partial derivatives are imbedded into the linearized 
syst«n state matrix, F(x(t), t), as shown in Figure 3.2-1 . A corresponding 

linearized measure.ment matrix, H(^), is similarly formed with the 
measurement equations' partial derivatives. 

3.2.1 System State Partial Derivatives 

Partial derivatives of each of the equations listed in Figure 3.2-1 
are developed in their oirder of occurrence with respect to the order of 


FIGURE 3.2-1. Linearization for Filter /anoother Model 



th« corresponding states. Partial derivatives of thrust terms are present* 
as though for c. single device. 


Inertial Position Rate Equation 

• (I ) 

Die first nonzero partial derivative of the r equation ic with 

^ ^ (B) 

respect to v 






(42) 


The second nonzero partial derivative is with respect to 6 . This partial 
derivative results in a third order tensor and occurs frequently in later 
developments. The generalized fomi is presented in Appendix A. 


Body Velocity Rate Equation 

The partial derivative of with respect to r^^^ is given for 

altitude terms approximately as 



(I) 



(43) 


where 


8v 


(B) 


8h 


Av 

ra 

2m 


- pAv 

op m 

«h * „ 


!j2. ^ »» 

9h 2m Oa Sh ^ 2m 8$ 8h 


1 n <i 

m 8p 8h 


8f^“^ 

8h 


_,(B) -.(o) 

-p 8et * ~p 86 

8a 8h ■ 86 8h' 


(44 ) 



3v 


Hie partial derivatives of 
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da 


ae 3a dfi 


3v 


9v 


(B) ’ ^ (B) ’ ^ (B) ' ah ' ah ah 


m 


3v' 


dv 


occur frequently and are given in Appendix B. 

The gravity vector partial derivative with respect 

to r IS 


B_1 ^ ^ 


dr 


(I) 


= V— H 


(I)|3 


r 


r r 

.12 


r r 
,13 


- 1 


r 




/ 2^3 


- 1 


,^1"2 


T T 


- 1 


(45) 


where 


M = gravitational constant. 

(B) 


9v 


Hie partial derivative. 


9r 


(I) 


, is the sum of the matricies in equations 


43 and 45. 


* ( B ) ( B ) 

Hie partial derivative of v with respect to v' is given by 


3v pAv Ov 

— m m 

, (B) 
ov 


2 2 
pAv 3c - - pAv 3c^. 

m -f da ^ m -t 

m (B) 2m 3a . (B) Ln 38 » (bT 

3v 3v 3v 


38 


, a 9f 

1 -p 3a — p 38 

m ^ 3a , (B) 38 > (B) 

3v 3v 


] - M 


(46) 


%i^ere 


s skew symmetric matrix made from the elements of the vector u 
and ec[uivalent to the cross product operator u x ( } . 

•(B) 

The partial derivative of v with respect to 0 is 


* ( B) 2 

9v pAv 5v 9v pAv 0c^ , 9v 

— m-r'^m-f9a-r 


96 


m ^ 0v 90 


2m 9a 9v 96 


ag ^,0 1 II) (I) , 

2m 9B 9v 90 90 ^ ^ 2. 


a4t(B) _ __(B) _ 

1_ , — p 9g T -p 9B — r 

^ m 9a 9v 96 ^ 9B 9v 90 


]. 


(47) 


•Rie partial derivatives of aure given in Appendix B and the partial 


9v 

-r 

90 


derivative -r:r is given in Appendix A. Ihe last partial derivative 


is given in Appendix C. 


(B) 


The partial derivative of v with respect to u is 


9v 


(B) 


pAv 9c- 

_ m -£ (B), 

0OJ ~ 2m 9(1) — 


(48) 



Euler Angle Rate Equation 

Ihe Euler euigle rate equation is a function of both the Euler angles 
euid the inertial rates. Ihe linearization will yield the two associated 
matricies. 

First with respect to the vector 0 _, the following matrix results 

2 2 ~ 
qsin9sec 6 -i- rcosfsec 9 0 

0 0 j 

qsinfsecOtanB + rcosq>sec 6 tan 0 0 


00 

00 


qcosiptanO- rsin9tan0 
-qsin9 - rcos9 
qcos9sec0 - rsin9cos0 


Hie partial derivative of 


0 


with respect to 


0) is 


00 

0 ( 1 ) 



sin9tan0 

COS9 

sin9sec0 


■ 

cos9tan0 

-sin9 

cos9sec0 


( 50 ) 


Inertial Angular Acceleration Equation 

The first partial derivative of this equation is with respect to the 
vector Using the approximation indicated in equation 43 , this 


( 49 ) 


partial derivative is 
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Next) with respect to the vector v , the partial derivative is 
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Itie parti.al derivative with respect to the vector is 
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•Hie final partial derivative for the first twelve states is with respect 
to the vector <d . Itiis operation yields 
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3.2.2 Measurement Partial Derivatives 


Itie measurements assumed to be available* as discussed earlier* include 
ground based radar tracking* inertially stabilized platform attitudes 
relative to the vehicle body* and stabilized platform mounted 3 axis 
orthogonal accelerations. As with the state dynamics matrix* the measure- 
ment equations are lineaurized about the best state estimates. 


Radar Track Measurement Equation 

Referring to the radaz track measurement equations* the required 
partial derivatives are 
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Itie last partial derivative in each of these equations* 7 rT~ » is 
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The rest of the required partial derivatives are 
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Inertially Stabilized Platform Attitude Equation 

The inertial platform is assumed to provide attitude ^mgle measure- 
ments of the true attitude plus an attitude bias plus measurment noise. 

The partial derivative of the measured attitudes with respect to the 
vector ^ yields an identity matrix. 

Accelerometer Measurement Equation 

The accelerometer senses specific body forces excluding gravity along 
the sensing axes. With reference to the accelerometer equation, the 
partial derivative with respect to r^^^ is 
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The partial derivative with respect to v yields 


da 


(S) 


8v 


(B) 


S^B[ m 


8v pAv 8c, - 

m m ^ 8a 

+ 


'’'"'m % as 


m -f _ (B) 2m 8a _ (B) 
3v 8v 


2m 8B - (B) 
8v 


1 8a 8B , 

8a g^(B) * 8S g^(B)' 


(63) 


Por the partial derivative of the acceleirometer with respect to 
the vector 0, the measurement equation is temporarily rewritten as 
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where the vector £ represents the sum of the aerodynamic, thrust, 

P' B 

plume and rotational coupling terms. The matrix C is the same 


matrix as 


C . The required partial derivative results from 
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The partial derivative on the right hand side is developed in Appendix A 
( B ) 

with the vector s_ representing the sum of the terms indicated above. 

The final partial derivative for the accelerometer measurement is 
with respect to the body rotation vector ui. Defining 
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and denoting as the i^^ element of the vector w, the resulting 

matrix is 
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3.2.3 Additional Parameter Partial Derivativea 


The tnathamatical devalopmanta are presented in this section for the 

partial derivatives of the system and measurement equations to allow for 

additional candidate parameters to be included in the estimation algorithms. 

Ihese pareuneters include center-of -gravity, r , moments of inertia, I, 

-eg 

wind velocity, \^, and inertial platform tilt errors. Aerodynamic and 
plume parameter partial derivatives are also presented. 

The computer program is being structured to permit these parameters 
to be easily incorporated without significant impact on the program code. 


3. 2. 3.1 Center-of -Gravi ty 

From equation 23, the partial derivative of angular acceleration with 
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From equation 32, the partial derivative of the measured acceleration with 

respect to r is 
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3. 2. 3. 2 Moments of Inertia 

The moments -of -inert! a are grouped into "principal" terms, i , and 
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cross product terms, i . From equation 24, these vectors are defined as 
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With these definitions, equation 23 is rewritten as 
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where represents the sum of the nonrotational torques in equation 23. 

Defining an intermediate vector a as 
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the partial derivatives of the angular acceleration with respect to 

i and i are 
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3. 2. 3. 3 Wind Velocity 

From aquations 20 and 25, tha partial darivativa of tha vehicle 
acceleration with respect to v is 
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The first of tha partial derivatives in equation 79 can be obtained 
from the following equation 
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From equation 80 , the following is obtained 
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etc., the following 
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Denoting the elements of the matrix C as c^ 2 » 

equations are obtained for the partial derivatives of a and B with 
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3, 2. 3. 4 Inertial Platform Tilt 


Temporarily rewriting equation (32) as 
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where 


63 = vector v^ose elements are the axes misalignments 

P* B 

s = sum of the bracketed terms in equation 32 multiplied by C . 


The following partial derivative of the measured acceleration with 
respect to 66 is obtained 
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3. 2. 3. 5 Aerodynamic and Plume Parameters 

A linear model for the aerodynamic and plume characteristics is 
used. *niis model is expanded as 
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where additional terms to represent rates, cross couplings, and controls 
can be included. 

The basic approach of establishing the partial derivatives will be 

illustrated for a couple of terms, c^ and c . Using these example 

^a -ma 


illustrations) the rest of the candidate parameters can be similarly 
obtained. From equation 20, the following partial derivative is obtained 
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vrtiere 


[U] = unit 3x3 matrix with one's (1 ) on the diagonal and zeros 
off the diagonal 

From equation 23, the partial derivative of angular acceleration with 

respect to c is 
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The corresponding partial derivative with respect to is 
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The static aerodynamic coefficient mcxiel has been obtained by a multiple 
regression analysis of the current aerodynamic tubular data. This model 
is presented in l^pendix D with the associated regression coefficients. 


3.3 Propulsion Parameter States and Measurements 


A candidate approach for incoi “orating the NASA propulsion model's 
capabilities has been identified. This approach utilizes nominal pre- 
dicted values of thrust, pressure, propellant and pressurant mass flow 
rates, and utilizes sensitivities o' partial derivatives of these 
variables with respect to the independent parameters selected for esti- 
mation by the algorithm. 

The approach is to include deviations frcMn nominal values of 
measured chamber pressure, nower level, propellant and pressurant mass 
flow rates as states. Tae xxlels assumed for these deviations are time 
correlated random processes. Then as states, partial derivatives of 
the first twelve states with respect to these variables will be required. 

For the SSME and SRB, this modeling approach is discussed in the 
following. Additionally, the necessary partial derivatives of the first 
twelve state variables with resepct to the additional states are presented. 


3.3.1 SSME Propulsion Parameter Model 

For the SSME, the total actual values of vacuum thrust and oxidizer 
mass flow rates are modeled by 
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The measurements of fuel mass flow ratei pressurant mass flow rates and 


power level are modeled as 
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and 


PL = PL + APL + b„, + . (97 ) 

nom PL PL 

These measured quantities inolude measurement noise s ^ ^ emd potential 
bias states b^ ^ modeled as random constants. In these measurements, 
the A'd variables are to be included as states in the estimfition 
algorithm. If tl% nominal values are zero or unknown, then the A'd 
vauriables cdasorb the entire estimate. Where required, the estimate for 
the variables used in the estimation algorithm is formed using the 
nominal and the estimate of the deviation, etc. In example, thrust and 
fuel mass flow rate estimates are formed as 
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The deviation or A'd measurement veuriables are modei'^d as time 
correlated random variables. Ihis permits these variables to vary within 
a band of frequencies. The typical model is then given as 
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where the parenthesis ( ) would be replaced by the variables, i.e., m . 

* 2 

For the SSME, an additional variable Ac is modeled as in equation 

mult 

100 and included as a state variable with the A'd measurement 
variables . 

The thrust deviation is expanded as in the following truncated Taylor 
series as a function of the independent parameters. 
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In the v and w equations, with equation 101 replacing f^ , 
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the partial derivatives of f^ with respect to the A'd variables are 
obtained directly from equation 101. 


It is desirable to include vehicle mass bias as a state. Ihe SSME's 


system contribution to the mass deviation is given by 
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In equation 101, the Am contribution to the mass deviation is not 
available from measurements. As with the thrust deviation, this quantity 
is formed as 
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vrtiich is in terms of other estimated state variables. In equations 101 
and 103 the deviation in mixture ratio, AMR, is obtained algebraically 
from 
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The partial derivatives for the SSME above have been incorporated into 
the estimation algorithm as functions of engine power level . 


3.3.2 SRB Propulsion Parameter Model 


“l^e approach for the SRB modeling follows closely that used for the 

SSME. Candidato independent parameters include propellant burn rate 

e)qx>nent, ai and motor efficiency coefficient* c . Others can be added 

m 

using this technique. 

The actual value of vacuum thrust is given by equation 92 . Hie 
only measurement available for the SRB is the total pressure at the 
forward head end of the motor case and is modeled as 
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where b^ ^ and s^ ^ represents a bias and measur^nent noise respectively. 

The independent pcuraneters, Aa and Ac , are included in the 

ra 

model as states. The model assumed can be as given by equation 100 or 
another suitable dynamical process, i.e., random constant. 

The thrust deviation is given by the following truncated Taylor 
series as a function of the candidate independent parameters . 
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The partial derivatives for the v and u equations with respect to 
the independent parameters are obtained directly from equation 106 . The 
mass deviation equation for the SRB is given as 
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The head pressure deviation, AP , is expanded similarly 
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A simplified model fo:r the SRB's thrust, head pressure and mass flow 
rate has been developed that can be directly incorporated within the filter 
algorithm for estimating bum rate coefficient, nozzle coefficient, mass 
flow rate, etc. Ihis model, to be described below, uses apriori specified 
burn area and port volume as a function of burn depth into the propellant 
grain. From this simplified model analytical partial derivatives required 
by the estimation algorithm can be obtained. 

The thrust is given by 

f _ = c c_ c m (110) 
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where 


c = nozzle coefficient 
m 

= thrust coefficient 

•k 

c = characteristic exhaust velocity 
m = mass flow rate 

TVo of the required partial derivatives with respect to mass flow rate 
and nozzle coefficient are easily obtained, vis 
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'Ihe partial derivative with respect to burn rate coefficient is 
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where it has been assumed that c is not a function of a. Using the 
"ideal" expression for c^ [7] 
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the first partial derivative in equation 113 is 
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1b evaluate the second partial derivative in aquation 113, the following 
equation for pressure [8] is used: 
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Ihe following partial derivative is then obtained 
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Ihe last partial derivative in equation 113 is obtained from 
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The resulting partial derivative is 
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1b utilizA the h«ad prassura measuramant and its sansitivity to 
paramatar variations « tha following aquation [7} is usad 
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R m gas constant 

T m gas absolute temperature 

c ■ port circumference 

A - port cross section area 
P 

r^^ « propellant burn rate 

i » distance from motor nozzle to pressure measurement point 


Ihis equation assumes a cylindrical port with an approximately constant 
cross sectional area. 

Ihe partial derivatives with respect to burn rate coefficient and mass 
flow rate are 
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In aquations 121 and 122 a cylindrical port has baan assumad in datarmininq 
tha port volumn V^. Equation 122 was obtainad from aquation 120 by 
raplacing tha tarm c r. p 1 by m. Tha partial darivativa of P 

°H 

with raspact to c^ is obviously zaro. In using thaaa analytical 
partial darivativasi tha basic parformance maasuras of thrust, mas low 
rate, head and nozzle pressures, ate. are matched between this mod« 
tha NASA SOBER internal ballistics routine results. Iha burn area and 
port volume are adjusted in the simple model to obtain tha agreement, 
man using tha adjusted area and volume as a function of burn depth, the 
partial derivatives are avalautad. 


3.3.3 V^ioI« Hblvs 


1h« total rata of changa of vahicla <raas is givan by 
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Iha first two terms in this aquation are the apriori assumed nominal 
values. The third and fourth terms ware discussed earlier. Ihe last 
term should be zero: however it can include a rnass bias uncertainty M 
Ihe equations, state and measurement, in which mass occurs are the 
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4.0 PROJECTED ACTIVITIES DURING UPCOMING MONTH 

During the next period, the filter and smoother routines will be 
further checked out and modified to include other potential parameters, 
i.e., aerodynamic coefficients. Additionally, the results from the 
simplified SRB model will be evaluated against those from the SOBER 


program . 
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APPENDIX A 


PARTIAL DERIVAUVE OF THE VECTOR v wrt 0 


Hiis partial derivative is one of several that occurs frequently in 
the formulation of the linearized system state and measuremetn eqautions. 
The desired partial derivative is 


(=os9cos4.)v, + ,stn»sinecos4.,^ ^ ,cos,sin0cos1. 

1 -cos<psin<|> 2 +sinq>sin4< 3 


30 


(cos9sin4.)v, + (Sin»sin9Bin,|,j ^ ,cos,Bin9Bin4. ^ 

1 -fcos 9 cos(|i -sin<pcos(|< 3 


(-sin0)v^ + (sinq>cos 0 )v 2 + (cosq>cos0 ) v^ 


A-1 


Itie resulting matrix is given in Table A-1 . 
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These partial derivatives occur frequently and will be developed 
in this appendix. The equation for v is 


(B) B LL (LL) 
V = V - C V 
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Since the wind velocity, v^^^\ is only a function of altitude then 
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APPENDIX C 


PARTIAL DERIVATIVE OF THE VECTOR 

Ihe third of the frequently occurring ] 
is 

cos0cos4» + cos0sin<t« 


^sinq>sin0cos4» ^ ^sin9sin0sin4* 

'-cos(psin(|i 1 -K:os<pcos4' 2 


^cos<psin0cos<l/ ^ ^cos<psin0sin4» 
^•«-sin<psin4' 1 -sin<pcos4* 2 


The resulting matrix is given in Table C-1 . 
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APPENDIX D 


AERODYNAMIC MODELING RE(3RESSION ANALYSIS AND RESULTS 


The aerodynamic data tables provided as IVBC3 data has been incorporated 
into 9n aerodynamic coefficient polynomial model. This modeling effort 
reduces the dimensionality of the numerical tables to one and reduces the 
storage re<|uirements for the aerodynamic model. 

The coefficient model used for the two stages differ slightly as a 
result of the available data. The regression analysis led in the selection 
of the form of the aerodynamic model. Terms with insignificant correlation 
were eliminated from the model. 

In equation form, the first stage static coefficients of axial force* 

C. ; normal force* C„; pitching imsment, C ; rolling moment* C. ; side force* 

C^; and yawing moment* C^; are given below 
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Thm corr®«ponding second stage model is given by the following equations 
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Ebr the first stage, data from an angle -of -attack range of -6 to 46 degrees 
was used in the regression analysis. Data from a range of -8 to 44 degrees 
was used for the second stage. The results, 1\JCX..., from the regression 
analysis is presented below for each of the coefficients, C , above. 
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TABLE D-2. First Sta^e Normal Fbrce Coefficient 
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TABLE D-3. First Stage Pitching Hament Coefficient 
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TABLE D-4. First Stage Rolling Moment Coefficient 
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TABLE D-7. Second Stage Longitudinal Coefficients 
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